A Motion Planning And Velocity Collision Avoidance Framework